A Separation Principle on Lie Groups 



S. Bonnabel* P. Martin* P. Rouchon* E. Salaiin* 



o 

-i— > 
O 

O 

oo 

(N 

U 

o 

•*-> 



> 

o 
o 



* Mathematiques et systemes, Mines ParisTech, 15212 Paris Cedex 06, 

France ( e-mail: 

[silvere. bonnabel, philippe. martin, pierre. rouchon] @mines-paristech.fr) 
** School of Aerospace Engineering, Georgia Institute of Technology, 
Atlanta, GA 30332-0150, USA (e-mail: erwan. salaun@gatech.edu) 

Abstract: For linear time-invariant systems, a separation principle holds: stable observer and 
stable state feedback can be designed for the time-invariant system, and the combined observer 
and feedback will be stable. For non-linear systems, a local separation principle holds around 
steady-states, as the linearized system is time-invariant. This paper addresses the issue of a non- 
linear separation principle on Lie groups. For invariant systems on Lie groups, we prove there 
exists a large set of (time-varying) trajectories around which the linearized observer-controler 
system is time-invariant, as soon as a symmetry-preserving observer is used. Thus a separation 
principle holds around those trajectories. The theory is illustrated by a mobile robot example, 
and the developed ideas are then extended to a class of Lagrangian mechanical systems on Lie 
groups described by Eulcr-Poincare equations. 
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1. INTRODUCTION 

The celebrated separation principle plays a key role in 
the linear theory of control. It states that the problem 
of designing an optimal stable feedback controller can be 
broken into two parts: designing an optimal stable observer 
meant to feed an optimal stable controller. As a particular 
application of this principle it is proved that for a linear 
time-invariant system, combining a stable observer and a 
stable controller yields a stable closed-loop system. 

When the system is non-linear, the separation principle 
does not holds. However a local separation principle can 
always be stated around steady-states, as the linearized 
system around steady-states is linear and time- invariant. 
But in general it does not hold around other types of 
trajectories. In this paper, we consider invariant systems 
on Lie groups, and we state a local separation principle 
around a large class of trajectories that are not necessarily 
steady-states. Note that separation principles for special 
classes of non-linear systems have been addressed in e.g. 
Atassi and Khalil (1999); Gauthier and Kupka (1992), 
Maithripala et al. (2005). 

Various systems of engineering interest can be modeled as 
invariant systems on Lie groups, mainly cart-like vehicles 
and mechanical systems such as rigid bodies in space. 
There is an extensive literature on control on Lie groups 
(see e.g. Bullo and Murray (1999); Grizzle and Marcus 
(1985); Respondek and Tall (2002); Morin and Samson 
(2003) and Jurdjevic and Sussmann (1972) as one of 
the pioneering papers), but general methods for observer 
design on Lie groups have only been introduced recently 
(Bonnabel et al. (2009); Lagemann et al. (2010); Mahony 
et al. (2008)). In this paper, a link is established between 
those two fields or reasearch and a separation principle on 
Lie groups is stated. 



In Section 2, we recall the linear separation principle, and 
the local non-linear separation principle around steady 
states. In Section 3, we consider a left-invariant system on 
a Lie group and we build a symmetry-preserving observer. 
It has been proved that, for such observers there exists 
a large set of trajectories around which the estimation 
error is time-invariant: the so-called permanent trajec- 
tories (Bonnabel et al. (2008, 2009)). In this paper, we 
prove that the tracking error is also time-invariant when 
the reference trajectory is a permanent trajectory. As a 
result, the linearized closed- loop observer-controler sys- 
tem is time-invariant around permanent trajectories. This 
implies a (local) separation principle around permanent 
trajectories. This result advocates that the recently intro- 
duced permanent trajectories for systems on Lie groups 
generalize steady states for general non-linear systems. 
Indeed, if the observer is not a symmetry-preserving ob- 
server, the linearized closed-loop observer-controler system 
around permanent trajectories is time- varying (in general), 
implying that a local separation principle does not hold. 

In Section 4, we consider the well-known problem of 
localizing from landmarks using sonar (see e.g. Betke and 
Gurvits (1997)). Observability follows from triangulation, 
and position estimation is generally achieved via the 
widespread Extended Kalman filter (see e.g. Roumeliotis 
and Bekcy (2000)). For this system we derive a class of 
symmetry-preserving observers that converge around any 
permanent trajectories (i.e. circles and lines with constant 
speed). The separation principle derived in this paper 
allows to prove that, as soon as the control scheme is 
stable around those trajectories, the closed-loop system is 
also stable around those trajectories and the eigenvalues of 
the closed-loop linearized system are those of the observer 
together with those of the controller. It is interesting 
to note that this stability result does not hold for an 



Extended Kalman Filter. Note that symmetry-preserving 
observers have already been used for localization from 
landmarks in Vasconcelos et al. (2007). 

Besides the two main contribution of this paper, which are 
to derive a (local) separation principle for invariant sys- 
tems on Lie groups, and to derive an observer-controler for 
the localization problem from landmarks with guaranteed 
convergence properties around a large set of trajectories, 
we consider in Section 5 a (very) particular observation 
problem for simple mechanical systems on Lie groups 
whose motion is described by Euler-Poincare equations. 
Such systems have been extensively studied in the litera- 
ture (see e.g. Bullo et al. (2000); Bullo and Murray (1999); 
Marsden and Ratiu (1994)). By a similar token as the one 
of Section 2 we prove a local separation principle around 
permanent trajectories. 

2. THE LINEAR SEPARATION PRINCIPLE 

Consider the system 

x = f(x,u) (1) 
y = h(x,u), (2) 
where (x, u, y) belongs to an open subset XxUxy C M n x 
R m x MP. We would like to track the reference trajectory 

X r — f {x ri Ur) (3) 

y r = h(x r ,u r ) (4) 
using only the measured output y. In other words we want 
to stabilize the equilibrium point (fj x ,fj u ) := (0,0) of the 
error system 

Vx = f{x r + Vx,Ur + Vu) ~ f{x r ,U r ) (5) 

rjy = h(x r + r]x,u r + r) u ) - h(x r ,u r ), (6) 
where r\ x := x — x r , r\ u := u — u r and i] y := y — y r . Here 
we are interested only in local stability, i.e. we want to 
stabilize the linearized error system 

L = dif(x r ,u r )£, x + d 2 f(x r ,u r )£, u =A£, X + B£ U (7) 

(, y = d 1 h(x r )£ :X + d 2 h(x r , u r )£ u = C£ x + D£ u . (8) 

The notation di stands for the derivative with respect to 
the i th argument. 

Notice the system (5)-(6) as well as the matrices A, B, C, D 
are in general not time-invariant unless the reference 
trajectory (x ri u r ) is an equilibrium point, i.e. is constant 
and such that f(x r ,u r ) = 0. 

2.1 Linear controller with linear observer 

To stabilize the linearized system, one can use the linear 
controller-observer 

(in = ~K£ x (9) 

i - a£ x + Bi u - L{ci x + d£ u - i v ) 

= {A-BK-LC + BLD)i x + LZ v , (10) 
where the m x n matrix K and n x p matrix L are to 
be chosen. Indeed, setting e x := £ x — £ x the closed-loop 
system 

ix = (A - BK)i x - BKe x (11) 
e x = (A- LC)e x (12) 

has a triangular structure hence its eigenvalues are those 
of A — BK together with those of A — LC. If (x r ,u r ) 



is an equilibrium point, it can easily be stabilized by 
placing separately the eigenvalues of A — BK through K 
and those of A — LC through L (provided of course 
(A, B) is controllable and (A, C) is observable). This is the 
well-known separation principle for linear time-invariant 
systems. The result still applies if the reference trajectory 
is slowly- varying, i.e. / (x r (t),u r (t)) « for all t; K and L 
may also depend on the reference trajectory to provide 
gain-scheduling. 

This shows that the control law 

Vu = ~Ki x (13) 

L = {A- BK - LC + BLD)i x + L Vy , (14) 

where the input £ y and output £ u of (9)-(10) are replaced 
by rjy and rj u , locally stabilizes the equilibrium point 
(Vx,Vu) '■= (0,0) of (5). In other words 

u = u r — K^ x 

L = (A-BK-LC + BLD)i x + L(y - y r ) 

stabilizes (1) around the reference trajectory (3)-(4) using 
only the measured output (2). 

2.2 Linear controller with extended observer 

Instead of the linear observer of the previous section, the 
so-called "extended" observer 

x = f(x,u) - L(h(x,u) - y) 

can be used. The n x p gain matrix L may depend 
on x to provide gain-scheduling. We assume this observer 
converges, i.e. the origin of the error system 
e x = f(x, u) - L(h(x, u) - h(x - e x , u)) - f(x - s x , u) 

is stable, where e x := x — x is the observation error. 
Once again we are interested only in local stability, i.e. 
we assume only the stability of the linearized error system 

e x = (dif(x, u) - Ld!h(x, u))e x . (15) 

Notice it is usually not easy to ensure even this local 
stability, unless the reference trajectory (x r , u r ) is an equi- 
librium point. In this case (15) can be further linearized 
around (x r ,u r ), which yields (12). 

The control law 

u = u r — K(x — x r ) 

x = f(x, u) - L(h{x, u) - y) 

then locally stabilizes (1) around the reference trajec- 
tory (3)- (4) using only the measured output (2). Indeed, 

7j u = -K(x - x + x - x r ) = -K(s x + r/ x ), 

hence £ u = — K(e x +£ x ), so that the linearized closed- loop 
system 

£ X = (A- BK)£ X - BKe x 
e x = (dif(x, u) - Ld!h(x, u))e x 
is clearly stable. 

3. A SEPARATION PRINCIPLE FOR INVARIANT 
SYSTEMS 

We again consider the system (l)-(2), but now X is a Lie 
group of dimension n with identity e and group law 

x 2 xi := <fi(x 2 ,xi). 



Definition 1. Let E be an open set (or more generally a 
manifold). A transformation group on E is a smooth map 

G X x S 0(a;,O G E 

such that 

• M e , £) = £ for all £ 

• 0(a;2,0(a;i,£)) = (j){x 2 x 1 , £) for all xi,x 2 ,£. 

By construction (/>(x, •) is a diffeomorphism on E for all x. 

Consider then the transformation group on X x li x 3^ 
defined by (f>(x , (x,u,y)) := (<£(x , a;), V>(x , u), g{x , y)). 
We will assume in the sequel that the system (l)-(2) enjoys 
the following important invariance property. 

Definition 2. The system (l)-(2) is invariant by the trans- 
formation group if for all xq, x, u 

• f{<f(xo,x),ip(x ,u)) = d 2 tp(x ,x)f(x,u) 

• h(ip(x 0l x),'ip(xo,u)) = g(x ,h(x,u)). 

With (X,U,Y) := (<p(xo, x), tp(x , u), g(xo, u)) this reads 

X = f(X, U) 
Y = h(X,U), 

i.e. (l)-(2) is left unchanged by the transformation group. 

Finally define the following "products" which provide very 
compact notations: for x G X, (x,u,y) G X x U x y and 
£ G T X X (T X X is the tangent space of X at x) 

x Q u := ip(x ,u) (16) 

xoy ~ g(x ,y) (17) 

xoZ:=d2<p(x ,x)ZeT XoX X (18) 

£x :=dw{x,x )Z&T XXo X. (19) 

Invariance then reads /(xox,x w) = Xof(x,u) and 
h(xoX, xqu) = xoh(x,u). 

We would like the invariant system (l)-(2) to track the 
reference trajectory (3)- (4). Instead of using as before the 
"linear" errors x — x r , u — u r and y — y r , we consider 
the errors r\ x := x~ x, r/ u := x~ u — x~ u r and r\ y := 
x~ x y — x~ 1 y r . These errors are invariant in the sense 
that (xox r )~ 1 (xox) — x~ x, (xoX r ) (xou) — x~ u and 
{xQX r )~ 1 {xoy) = x~ l y. The error system is then given by 

Vx =x~ 1 f(x,u) - (x^ 1 f{x r ,u r )x~ 1 )x 
= »7x/(e,a; _1 u) - f(e, a^V^x 
= Vxfie^Hlr+Vu)) - f(e,I r )Vx (20) 

f~ly — ■ x j, hiiypc ■ x j, h^Xf • x 'p ^ 

= h(r] x ,I r +T] u )-h(e,I r ), (21) 

and we want to stabilize its equilibrium point (f] x ,fj u ) := 
(e, 0). We have used the important invariant quantity 

if • "" X y. Uf J 

which leads to the following definition of a class of remark- 
able trajectories. 

Definition 3. The trajectory (x r ,u r ) is permanent if I r is 
constant (i.e. independent of time). 

Once again we are interested only in local stability, i.e. 
we want to stabilize only the linearization of (20)-(21) 
around (fj x ,fj u ) := (e, 0). Recall that to linearize around e 
the map i] x G X M> g(i]x), one can write r\ x = exp(s£r) 
where exp is the exponential map of the Lie group X, 



set and £ x G T e X (T e X is identified with the Lie algebra 
of X). The linearization of g is then given by 



— g(exp(s£ x )) 



= #iS(e)£r. 



Applying this to (20)-(21), we find the linearized error 
system is 

L = £x/(e,ir) - f{e,I r )£ x + d 2 f{e,Ir){iu - £, x I r ) 

= A£ x + B£ u (22) 
£ y = dih{e, I r )ix + d 2 h(e, I r )£ u 

= C^ X +D^ U , (23) 
where we have defined the "products" 
£u := <9iV>(e, u)£ 

CC := (9ia 2 ^(e,e)C)C = (%5i^e,e)C)€ 
for u G U and ( G T e X. 

Notice the system (20)-(21) as well as the matrices 
A, B, C, D are in general not time-invariant unless the 
reference trajectory (x r ,u r ) is permanent. Since (22)-(23) 
has the same form as (7)- (8), we will be able to extend 
the usual separation principle around equilibrium points 
to a separation principle around permanent trajectories. 
The main benefit is that there are many more permanent 
trajectories thant equilibrium points. 

3.1 Linear controller with linear observer 

To stabilize the linearized error system (22)-(23) we can 
use a linear controller-observer of the form (9)-(10). As in 
section 2.1, the control law (13)-(14) with r\ x ,r\ u replacing 
stabilizes the equilibrium point (fj x ,fj u ) '■= (e, 0) 
of (20). Using the definitions of r) u ,r} y and the fact that 
x~ 1 (x r u) = (x~ 1 x r )u = we eventually find that 

u = x r (I r - k£ x ) 

£ X = (A-BK-LC + BLD% + L(x~ 1 y - h{e, I r )) 
stabilizes (1) around the reference trajectory (3)-(4) using 
only the measured output (2). 

3.2 Linear controller with invariant observer 

Following Bonnabel et al. (2008, 2009), we can easily de- 
sign an invariant extended observer for invariant systems, 
using the invariant output error e y := x~ l h{x, u) — x~ 1 y 
instead of the "linear" output error h(x,u) — y. Such an 
observer reads 

x = f(x, u) — xL(ir _1 /i(i:, u) — x~ 1 y), 

where the gain matrix L may depend on I := x~ 1 u and 
on the output error e y . 

The error system for the (invariant) state observation error 

£■ 2c • — X X IS 

e x = x^ 1 (^f(x, u) + u) — x _1 /i(x, m))^ 

— x^ 1 f(x, m)x _1 x 

= e x f(e,I) - f(e,ej)e x - e x L{h{e x x , t) - h(ejj), 
and its linearization around the origin is 

e x = e x f(e, I) - f(e, I)e x - d 2 f(e, L)e x - Ldih(e, I)e x . 
It is then easy to tunc the gain matrix L so that the 
observer converges at least around permanent trajectories. 



Mimicking section 2.2 the control law 

u = x r {l r — Kk(x~ xj) 

x = f{x, u) + xL(x~ 1 y — h(e, I)) 

then locally stabilizes (1) around the reference trajec- 
tory (3)-(4) using only the measured output (2). Here k is 
any map such that 



— «;(exp(s£)) 



s=0 



for instance a determination of the logarithm map of 
the group (i.e. the inverse of the exponential map of the 
group). Indeed, x~ l u = I r — Kk(x~ xx x), i.e. r\ u = 
—Kn{rj x e x ). Linearizing, this yields £ u = —K(e x so 
that the linearized closed-loop system 

L = (A- BK)£ X - BKe x 

e x = e x f(e, I) - f(e, I)e x - d 2 f{e, I)e x - Ldih(e, I)e x 
is clearly stable. 

4. EXAMPLE: OUTPUT CONTROL OF A WHEELED 
ROBOT FROM SONAR LANDMARKS 

Consider the simple planar non-holonomic model of a 
wheeled robot 

x = uC9 
y = uS9 

9 = uv, 

where the control inputs are the velocity u and v the 
tangent of the steering angle; CO and SO stand for cos 9 
and sin#. We take for measurements the (square of the) 
distances to p > 3 planar landmarks with known coordi- 
nates (x l ,y i ), 

K = (x - Xif + (y - yi) 2 , i = l,...,p. 

The measurement system could be for instance a set of 
ultrasonic emitters located at (xi,yt), while the robot is 
equipped with ultrasonic receivers measuring the time of 
flight of the sonic waves. 

Notice the only equilibrium points are given by u = 
and x,y,0,v constant, i.e. the robot is at rest. Moreover 
the linearized system around these points is clearly not 
controllable. Hence it is not possible to use the linear 
separation principle of section 2. 

It is easy to check the composition law 
fx \ /x\ fxCd - yS9 

[vo )\y )■=[ xse + yco 
\o J \ej V o + o 

with unit element and inverse defined by 




and 



is a group law. Moreover 



-xC6 - yS9\ 
xS6 - yC0 o 

-o J 
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XiS6 
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ViSdo 

y t ce 

A,- 



x 

- yo 



) 



defines a transformation group. Notice the beacon 
nates (xi,yt) can be considered as known constant 



coordi- 
inputs. 



Direct computation shows the system is invariant in the 
sense of definition 2. Notice u, v are invariant, hence the 
permanent trajectories are defined by 

x(t) = u s'm(uvt + 0) 
y{t) = —ucos(uvt + 0) 
0(t) = uvt, 

where u,v,9 are arbitrary constants; there consist of 
arbitrary circles (when v ^ 0) and lines (when v = 0). 

4-1 Design of a linearized state controller 
The state tracking error is 

/rix\ /x r \ ~ /x\ / (x - x r )C9 r + (y - y r )S9 r \ 
\Vv ) ■= [vr] \y = ~{x - x r )S9 r + (y- y r )C9 r 
W W W V 0-6 r J 

and satisfies 

/Vx\ ( C9 r S9 r 0\ (x-x r 

[fly = S6 r C9 r 0) \ y- y r 

W V 1/ \6 

(S9 r C9 r 0\ fx-x r \ 
+ 9 r -C9 r -S9 r \y-y r ) 

V o o o/ V o J 

/(u r + r] u )Cr\Q - u r + u r v r r) y \ 
= K + Vu)Sr]0 - u r v r i] x 
\ (u r + r) u ){v r + r) v ) - u r v r ) 

The linearized error equation around (fj x ,f]y,f]g,f} u ,f] v ) = 
(0,0,0,0,0) is then 

£,X Cu "i" U r V r ^y 

£,y = U r ie - U r V r ^ x 
£.8 = V r £ u + U r £ v . 

If we choose for instance the state feedback 

£ v = sign(u r )fci^ x + v^y - k 2 £, v - sign(u r )fc 3 ^ 
the resulting closed-loop 

£,x = ~\ u r\kl£,x 

£,y = u r £ e - U r V r £ x 

£0 = -u r k 2 i y - \u r \k 3 £9 

with fci,fc2,fc3 > is obviously stable for u r ,v r constant. 
It is even stable for non constant u ri v r provided for u ri v r 
are bounded and J 4 ^° c '\u r (t)\alt = +00 for all i > 0. 

4-2 Design of an extended observer 
The output observation error is 

Ei ■= (^j ((x - Xi) 2 + (y- y t ) 2 ) - ^yj \ 

= (x - Xi) 2 + (y- y t ) 2 - Xi 
and the "product" (18) is 

fx \ (C9-S9 

\yo k = \ se c§ 1 ? 

\doJ \ 1 







(uce 






use 










Every invariant observer then reads 

'C6 -S6 o\ 

se ce o\l 

1/ 

where L is a 3 x p matrix possibly depending on Ei and 
the invariant quantities 

/ Iu\ /-n -l /u\ ( u \ 

V4/ 




(a* - x)C0 + { Vi - y)S6 

\-(xi-x)se + ( yi -y)cej 

For reasons that will shortly be apparent, we choose 

L := -^Cill 1 )- 1 ! 

where C is a 3x2 matrix to be defined and I is the 2 x p 
matrix 



1 := 



4i ' ' ' ly 



Notice (H T ) 1 is always invcrtiblc when p > 3. 



The state observation error 
-l 




(x - x )ce + (y- v )se \ 

-(x-x)Se + (y-y)Ce) 
6-6 1 



has for equation 



ce se o\ 
-se ce o 

1/ 



'-so ce o 
-ce -se o 
, o oo 




ce -se o 
se ce o 
o o 1 



(u(Cee — 1) + uve y \ /Cee —See 0\ 
—uSee — uve x ] + I fee Ceg J L 
o / V o o i/ 

with 

£, = (£- + (y - k) 2 - {x - Xif - (y - yi) 2 

-2 (..r, - r //, -(/) I ;. ' ) - (x - xf - (y - yf 



-2(4 4) 



x — X 

v-y, 

co se\ fee -se\ < . 
se ce 



-se ce/ — / w, 

Linearizing around the equilibrium point (s x ,e y ,£e) '■- 
(0, 0, 0), we have 



with 



Hence 



' UVty 

—uee — uve x 




- 2 (4 4) 



-2X J 




so we eventually have 

/e x \ / we y \ 
e y = -we e - uve^ - , 

W V J 
If we choose 

(\u\l\ uv \ 
|u|Z 2 
-ui 3 / 

with Zi , Z 2 , Z3 > 0, the linearized error system reads 
e x = ~\u\he x 
e y = -ue g - \u\l 2 e y 
e g = -ul 3 e y 

is obviously stable provided J^°°\u r (t)\dt — +00 for all 
to > 0. This means the designed observer is convergent 
locally around every trajectory. 

4-3 The control law 

Combining as in section 3.2 the previously designed lin- 
earized controller and extended observer we end up with 
the control law 

u r — u r v r f] y — \u r \k\f) x 
v r s\gn(u r )kifj x + v 2 r ^ y - k 2 fj y - sign(u r )fc 3 r} e 






fee 


-so o\ 


H 


se 


ce 




\ 


1 




(x — x r )C6 r + (y — y r )S6 r 
— (x — x r )Se r + (y — y r )C6 r 

e — 6 r 

Notice the map k chosen here is simply the identity. This 
control law stabilizes the system around any permanent 
trajectory. 

5. FULLY- ACTUATED MECHANICAL SYSTEMS ON 
LIE GROUPS 

In this section, we consider a simple mechanical system 
on a Lie group whose motion is described by the so-called 
Eulcr-Poincare equations. We focus on fully-actuated sys- 
tems arising in control theory as described by e.g. Bullo 
and Murray (1999) 

x = f(x,0 (24) 

i = A(£)+r 1 {F(x,0+u) (25) 
where x £ G is the (generalized) position, with G a Lie 
group (the configuration space), £ £ T X G is the (gener- 
alized) velocity, A is a bilinear function of its argument, 
I^ 1 {F(x 1 is the resultant force acting on the system, 

and u £ T X G denotes the control. Moreover, the system 
(24) is invariant to the following G-group action : for any 
xq £ G the action xqx is the left multiplication on G, and 
x £ = £• 

5.1 Considered observation problem 

We assume that £ is known or measured, and dropping the 
second equation (25) (as £ does not need to be estimated), 
we focus on the following observation problem: 



where the output satisfies Xoh(x) = h(xox). The theory 
of Section 2 applies to this problem, and the permanent 
trajectories are generated by constant velocities, i.e. I r = 
x~ l ^ r = £ r = est. Such trajectories are very natural for 
mechanical systems and admit a geometrical interpreta- 
tion (they are generated by one-parameter subgroups of 
G) . They constitute interesting motion primitives that can 
be concatenated to yield a very large class of trajectories 
(think of straight lines and coordinated turn in avionics 
which are permanent trajectories on SE(3) Bonnabel et al. 
(2009)). In the sequel we will prove that a local separation 
principle holds around those trajectories. 

5.2 Control problem around permanent trajectories 

Consider the reference trajectory (x r (t), £ r ) generated by 
a time- invariant £ r . Let u r be the corresponding control. 
Let the invariant tracking error be (r] x , rj^) — (x~ x, £ — £ r ) 
as in Bullo and Murray (1999). As the system (24) is 
invariant, applying (20) (where u is replaced by £) we have 

^Vx = T(n x ,n s ,I r ) 
Moreover we have, up to second order terms in (r] x ,r]^) 

= A(I r + m) - A(I r ) + r 1 (5 1 F{x r ,I r )r lx 

+ S 2 F(x r ,I r )r] i +i] u ) 
We have thus the following result: 

Lemma 4- If S\F(x,£,) and 8zF(x,£) do not depend on x, 
the linearized tracking error around permanent trajecto- 
ries generated by £ r = est is time-invariant. 

It implies that under assumptions of Lemma 4 (which are 
usually satisfied in practice), a local separation principle 
holds around permanent trajectories for the control prob- 
lem (24)- (25) combined with an invariant observer for the 
subsystem (26), and where £ is known or measured. 

We believe that the problem addressed in this section is 
relevant to applications, and examples are left for future 
research. Note that Maithripala et al. (2005) proved a 
separation principle for simple mechanical systems on Lie 
groups where the position is measured, and a velocity 
observer must be designed. This is a different problem and 
a different approach is developed. The drawback of this 
approach is that it relies on many restrictive assumptions. 
In particular: the group must be compact, and the observer 
must be exponentially convergent around any trajectory. 

6. CONCLUSION 

In this paper a local separation principle around a large 
set of trajectories for non-linear invariant systems on Lie 
groups was proved. We also proved that the results extend 
partially to the control of simple mechanical systems on 
Lie groups. In future research we plan to explore examples 
of mechanical systems for which those results apply. 

REFERENCES 

Atassi, A. and Khalil, H. (1999). A separation principle for 
the stabilization of a class of nonlinear systems. IEEE 
Trans, on Automatic Control, 44:9, 1672 -1687. 



Bctkc, M. and Gurvits, L. (1997). Mobile robot localiza- 
tion using landmarks. IEEE Trans, on Robotics and 
Automation, 31:2, 251 - 263. 

Bonnabel, S., Martin, P., and Rouchon, P. (2008). 
Symmetry-preserving observers. IEEE Trans, on Au- 
tomatic Control, 53(11), 2514-2526. 

Bonnabel, S., Martin, P., and Rouchon, P. (2009). Non- 
linear symmetry-preserving observers on lie groups. 
IEEE Trans, on Automatic Control, 54(7), 1709 - 1713. 

Bullo, F., Leonard, N., and Lewis, A. (2000). Controllabil- 
ity and motion algorithms for underactuated lagrangian 
systems on lie groups. IEEE Trans. Automat. Control, 
35, 1437-1454. 

Bullo, F. and Murray, R. (1999). Tracking for fully 
actuated mechanical systems: A geometric framework. 
Automatica, 35(1), 17-34. 

Gauthier, J. and Kupka, I. (1992). A separation principle 
for bilinear systems with dissipative drift. IEEE Trans, 
on Automatic Control, 37:12, 1970 1974. 

Grizzle, J. and Marcus, S. (1985). The structure of 
nonlinear systems possessing symmetries. IEEE Trans. 
Automat. Control, 30, 248-258. 

Jurdjevic, V. and Sussmann, H.J. (1972). Control systems 
on lie groups. J. Differential Equations. 

Lagemann, C, Trumpf, J., and Mahony, R. (2010). 
Gradient-like observers for invariant dynamics on a lie 
group. IEEE Trans, on Automatic Control, 55:2, 367 - 
377. 

Mahony, R., Hamel, T., and Pflimlin, J.M. (2008). Non- 
linear complementary filters on the special orthogonal 
group. IEEE-Trans, on Automatic Control, 53(5), 1203- 
1218. 

Maithripala, D.H.S., Dayawansa, W.P., and Berg, J.M. 
(2005). Intrinsic observer-based stabilization for simple 
mechanical systems on lie groups. SIAM J. Control and 
Optim., 44, 1691-1711. 

Marsden, J. and Ratiu, T. (1994). Introduction to Me- 
chanics and Symmetry. Springer- Verlag, New York. 

Morin, P. and Samson, C. (2003). Practical stabilization of 
driftless systems on lie groups, the transverse function 
approach. IEEE Trans. Automat. Control, 48, 1493- 
1508. 

Respondek, W. and Tall, I. (2002). Nonlincarizablc single- 
input control systems do not admit stationary symme- 
tries. Systems and Control Letters, 46, 1-16. 

Roumeliotis, S. and Bekey, G. (2000). Bayesian estimation 
and kalman filtering: a unified framework for mobile 
robot localization. In ICR A '00, 2985 - 2992. 

Vasconcelos, J., Cunha, R., Silvestre, C, and Oliveira, P. 
(2007). Landmark based nonlinear observer for rigid 
body attitude and position estimation. In Proceedings 
of the 2007 IEEE CDC, 1033 - 1038. 



